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= (54) Title: ROBOT DEVICE AND METHOD OF CONTROLLING ROBOT DEVICE OPERATION 



(57) Abstract: A robot device comprising 
parts of the body such as the head (4) 
and legs (3A-3D), an actuator (25) for 
driving parts of the body, and the CPU 
(10) for outputting control signals to 
the actuator (25). The device calculates 
external force-related information such 
as the position, magnitude, and direction 
of an external force applied to the robot 
device based on changes in control signals 
that are output from the CPU (10) to drive 
the actuator (25) and in signals that are 
input to the CPU (10) as responses when 
the actuator (25) is driven. This external 
force information is used as information 
for selecting, in collaboration with the 
behavior and emotion of the robot device, 
the next behavior of the robot device. 
Since the robot device calculates external 
force information based on outputs 
from the CPU (10) and outputs from the 
actuator (25) and a potentiometer (26), an 
external forced can be detected depending 
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on existing apparatuses without the need of adding a dedicated sensor. 
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#tfeffl£& D * v h * Mffll t S fc ft © 7 s d * 9 A N £tf cd 7" n 7* 

h =§£g© iMt $ll$|l£&s £ © ®J#§iJ$P 0 fc ft © 7 n 7 5 A % srrccrn^ 

?FI8l^ CCD (Charge Coupled Device) A^7^?On*>IIi 
Ut^^ £©C CD2M 5£<fc^tiS«bfcJSH©>R$51-$\ v^d$>(; 

If* 6 ft UK U C©fl«IS*fc:aS^^r g # ftt frill ft &£b 

rc:Hft$B:!I1"-§<k5££*i't^.5o 

r $ # ff © m c § b k m m b * v a «t a & M e. * © x * # & s c * s . * c 

0S*«, CCD *^5*e,m^^tl5H^«^(-»^^Tl^^tlft^tBb> c 
©^tHIS^tS^^TPf *t)ft?i»Tff »f « «t a {3D spy hg»#gB© 
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« d # y h mmo&w t *-fe > * * #30 fc » * is * © as* v> x nmm 

tzzft, ? 6 ©MM *J8v> M^Sfcajf 3©£ 

01*. fix WJfe©»f^ (^Sf i) 3 z. t % X % 3 J; 5 o t ^5. 

& >f > * ^ a > £ & l tr £ # t? s * . 
iic^tfxC©*? tzmmmmmv^yv-ku-xv h&ia ©Ernsts 

* 5 * a >i>SE^t t * o . 012.HU A^ip^fenfc^ftftifcfflt-** 
mm® wiw % Hff * # & #> t ±sb urn * m * t- * wflM £ % ± m# 



WO 02/065825 



PCT/IB02/00544 



3 

tits *»?5C**50#9 h%m®fflfflfi&te<> Wflifll^fcAor nsK«y 
JiiB«jfis^^:cDi6ftacD^P0'f@^^= , ±5'r ^ -f^ m ^ its ^ +^ i:. _tHBfj5ij«^i^^ 

±fi»fl£¥«fc* ^fc±IBfl^fiSy c ±fBKi#gt&fcH#©fc J: Dtffi^ftfc 
tS^VM^ ±IBD^ y h g g ^ 0 ft t\ % $ ffi T * ft * tft tH X |M t & D # V h 

©tt^lM^^-r SMiitx ft^jtfia*. £>*ifc i: & ©±i3Pi»m^©^ibK: 
jatUff ^-fr* ?°p ^-5 AAsiBS^nt^So 

B 1 Its *»W0aS**rtft*««fcjj***:?n ^BT!i4. 

|2tt, B9 1 ©«*«l^^llfTt§^3i^^tK^^So 

El 3 ti s 02©Xr^S 3 $ %fs t % K IBM L fe 7° P ^ 5 A t & § = 
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m 4ft s bM©^«;«^tMHl!&3 0 

8 5li, ^ v b D b ©HIM J$£^t 7*n y 7 m^h £ = 

0 6ft, M-^M3Ilsl8&©«J&£^f 70 

III 7 ft s ff§U $P 7n^7A®V7 b ^x7llSIi6!]t^t7a v tmnfo 
III 8 ft, > FJV-^7-M70V7b ^x7lfil^fti;Wi:^t7 , n y 

7 EI 1 % 0 

H 9 ft s 77H- > >a>' b £^ T £ ft^KH;: *s T 7 D 

9> 7 HI X" & § o 

in i oft, fiitr^7-f 7^ y ©^^^^tit^iin?^ o 

suit in$#- v v b yttTFtnikM-zhho 

hi 2 a, ^MM^^i-m^a^So 

m i 3 ft, a* v v mwfc&tt % % tz & ®±mmm%^t 7 u 

la i 4it p w m ji/ t. t mm b ;v 7 t © s ^ t m -e a § „ 
mi 5 ft, pwMiMiztmm v )i? to^^^-r^^m^tb s « 

HI 1 6 It P WM^J]/7 b ;V7 t ©IH^£^f o 

11 7lt p wm;^m « b ;v7 h©P^£^1- i &t£HI~e& 3 o 
n i 8 ft , *-fe>-9-^7sxix©#i^s^i-ia-cs^o 

HI 2 1 ft , s? a y b 1 £fcft <§> > mm © b t * b b £ 

m 2 2 a , y a 4 y b itiMn, mm © b k ? t k £ & ntc b >v v t 

12 3ft, ygOF2t*»4s HI © b ;i/ 7 && t «fc t) life b )W t 
m 2 4 ft s a -T > b 2 fc£ ft 3 , US) © b ;v 7 t £ «fc t) »fc b )V 7 t 
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m 2 5 fi , V a A y h 3 £ » I. v gs*i © h ^ # t £ J: fc> ff & h ;i/ £ h 
© Wff Si *c * * . 

® 2 6 fcJu $> a -f > h 3 1 £(i 4 s ^tJ © h * i: *ft t <fc !) fe Wl> * & 

K2 8 fi N s^?©^iRi^^*^ibn^ 5> tife^©^^&^-r#ffi0t"$>^o 

EI 3 l {is try ^£iRiJSr*^ax-* icWf**^!! ©»«£** 
11 3 2 {is #M^£^«B0~e;g>3o 

Ei3 3{is %fe&m®mmizmt%Wii&m^&%o 
H3 4{is %fe&m<Dmmiziitt %mzm-e& %o 

03 5ii,Il~I 3 ®|Bgi&tfefcH£$*fc «k 3»«fe&£ti©SBIftfc:{ft'r S« 
036|i,il~I 3 Hi ,fcS|B^«ltftttJ0UiWI^^-rs«[ 

S3 7(ixll~l 3 ©P?*MtB£&{-i aWSt&tfcfcHOKWCttf*!* 

ei 3 8 {is g^^^ffltfji^SfflittBa^tti-sm^sitf 
m 3 9 {is M«m«^Ji&^-f ? n-?-^- h t? *«o" 

$$)5UlJ©Ji#0J lt^tn#9 hSStts JUHfflJliJt (ftMB) ^> ft SB 
^KSSttts 0HiU£s ^-if^^iotf*#^tife*^lf«tli:©^M^ ir 
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*^ftiifflits @ k 2 tc^-rj; a c> fl^sfljesu loi, i 

0 2 x frBBiji^aiJ 1 0 3 * UTs ft «J £ SB lOl^n*^* 

«KJat5«^A<Offi*N ^InF^ (^9781), ft## 

#fgB 1 0 2ttftM^ 1 0 1 6CA*tfl^A©lS^^I L (*x y 
7S2), ff l&S^SB 1 0 3 liftoff SB 1 0 2 n # y h 

mm $ fi % o m 3 © r d ^9 a j* n d jjt * h 3t*&jta 3 ©11 n # s> 
vmmommizm^^xikcD^ m^M^t §§<ta tia^^ f 0 r c e k 

indil, BehaviorStatusMs ForceDirecti 
fa%m\s,ftmmM 1 0 3 t± N £ft5>ft*©'»M & t K: fx »©*JR*ff 5 . 

(1) P^nilffl«*6!)&II 

$>£^y Hn*y b iiStuMttSP^-y b 2 © iu^££ £ tiPSU^- 
-j» b 3 A, 3B; 3C, 3 DftMmShZt&lZ, Mfcffi*.- V V 2 CD su Sim 

ass v&«a$t * tu^tiM-a.- * y 4 stFRi^i- y v 5 nx 

IftgUa- y m 5 \Zmt & O fcs CPU ( Central Processing 

Unit) 1 0, DRAM (Dynamic Random Access Memory) IK 7 7 r> 
a ROM (Read Only Memory) 1 2 S PC (Personal Computer) — h* 
4>*-:7x-2|eIK&1 3SVifji!H@B 1 4 asftgMt* 1 5 ^btl 
ItSi^ii* £ fcfc «fc DJBJfcSft&n > h n-;i/» 1 6 fc, H©n#y h« 
g 1 omtsUb LXOrtV?- U 1 7 iitflKfflSftTV^o Jfittg&i-v 
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h 4 fcfc^ ^^0t)8^»tt5fe»0CCD (Charge 
Coupled Device) Oil, Mffl^A^© r it?.j * fop < j V^ o & 

3fc&©-?^ V p*> 2 3fc N ni^#®^£ffl;bTr3fc&ffl*t°-#2 4 

ilx D/]ty fill® rgj };i^tliLED (Light Emitting Diode) (El 
$ & l-s #WSPJL= V \ 3 A~ 3 D CD li fill f h 3 A ~ 3 D 

&mmfr®T V J-^^~t> 2 5j~2 5 n ^t>"*x>^>3^-^2 6 x ~2 6 n 
flffifcil bT^bTV^^o^-* ; B-^©lEli)t t j;DsP§|3^-^b3A~3D 

-b>^2 2, ?OD*>23, ^t-*2 4»tf#^r> >> a ^ - # 2 6 x 
~ 2 6 n & if©#a-fe Vi^tVCLE D & £ ^ a x - £ 2 5 x ~ 2 5 n 

fix ^tl^H*tJSt5^7 2 7 x ~ 2 7 B t^bt3 > h n-;i/tf 1 6®It 
MHIES 1 4 fcii^fts CCDA^52 OMn^r'J 1 7 {£> Ztl^tlM 

»r£tt« 3;fcli^MI51S§ 1 4 lis U^C/t'J'fiJ i 7 

IDRAM 1 1 ftCDffifetfLmfcfeffltZc 

^r-^SV^^T'JllT-^lt CCD^CPU 1 0 # D # * F 1 © «J 
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npf±cp u i o DTjty fisi ®mm&mx£ txfrwmms mm^. 

b 2 © H * b ft l,N P C * - F X n a> ftgil^tifc^^'JA-n 8 x 
!477S'J'aR0M12l:«Hi$ilfeM7ny5AftPCA-N>*- 
7 x-aBK 1 3&:frbTXtttt&B&frffiU;ift&DRAMl 1 tjfeHtS. 
Sf:, CPUlOit £©&±*&©<k-5 K:fl|-9«L3B@IS 1 4 J; D DRAM 1 

$ & cpui o j± x c©fl»fig^stKD r am i i 

y h 3 A ~ 3 D £ i£ 16 £ * T #fr 3 * 3 ft £ © fr 86 & fx to 3 o 

^fc, c ©Pi c p u i o tt^ £^n$bTf^T-^ 

< ^ & tts a £ « s? . ±$© l e d «<rxtt 

6 bT g^WKfrlfr b#3 £ 5 Kft£friTV\ 

-?> o 

( 1 - 1 ) MH]g§©M 

M-t^aaiSIK 1 4 l±s DMA (Direct Memory Access) 3 > h O — 53 0^ 
D S P ( Digital Signal Processor) 3K ^>J 7x7;W 3 
2 S N?33, FBK/CDT (Filter Bank/Color Detection) 3 4 N IP 
E (Inner Product Engine) 3 5\ ^ 'J 7JV;U*X b 3 > f D-7 3 

'J 7^1/^7 3 7 # 7t x 3 8St;^|;U3 8 © ffi til © II f? £ ff 9 ^ * 7 

-if ^ 3 9 £jn$^ b-ot* 4 o izmmznz t£\Zs ^m^x 4 0 #**x-e 
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>^-7i-^43^btDRAMl 1 (H 5 K CPU10 ( E3 5 ) S V 
77>r>aROMl 2 ( g| 5 ) tM£tls AoAiJ 7 x7iW >^-7 x- 
7. 3 2 /I 5 U ;i/ * - h 4 4 „ M y x U V # - $> * 4 5 & If ^> U 7 )V * - h 4 

2 1 , EEKI-fe >it22,V-f^D*>23,X t'-# 2 4 „ ^-T^ 5^ a x 

-^ 2 5 (2 5 1N 2 5 2 , 2 5 3 ) SVt*r>>>3^^ 2 6 ( 2 6 n 

2 6 2 s 2 6 3 ) ifflr/tnas ?n?^7*2 7 ( 2 7 , ~ 2 7 r: ) £ 

0 (0 2) SFBK/CDT34 hig|«£ fro;* <J17 (0 5) tt^ 
yf !Jv^-^t4 5 i; g j& $ ti T ^ § c 

^j^^-fe > it 1 8, Mfil-fe>-y- 1 9, «M^tH2 1, EgH-te>-y-2 2&I>"& 
*r>^a^^ 2 6 ( 2 6 : , 2 6 2 , 2 6 3 ) «©#-k > * * S> * tl* 

btlit^DMAnV 3 0© M © * il K: N d ft £ -fe > — * § 

;\"X3 8, ;t^T-tT^39 N ;U4 0SlFDRAMr/^-7x-X4 1 £ 

^^5*-^ IDSP3 lfc$gfcHr3J:&^ DSP3 liis o0^^r-^t 

>bn-7 3 0 ©fM$0fc £ £n 8 N ;U7-t*^3 9 „ A7 4 0Sy 

DRAMO^-7x-^4 1 SIS^ttDRAM 1 1 fcKSiU Cfrfci 
IDRAM1 1 rt0HTT^©SBItMii^m#J-r§c 

JfeFBK/CDT34I^CCD^ 7 2 0 is* h £ tl * Mftx - # * 

DMAn > h d-7 3 0 ©$iJfP©t) AX 3 8 S 3 9, AT 

4 0SU t DRAMr^-7x-^4UIMbtDRAMl 1 (05) K 
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I^St^'^'J^ir^^^s DMA3>hD-7 3 0 © £J $ P © % fcfc> ^ 
ij7i7jH>^-7x^3 2 s ;U3 8 S /U7-^^3 9 x ^X 4 OS 
tfDRAMO^-7i-X4 1 ^IMbtDRAM 1 1 t> H h & 

ssdrami i &(DPixfc(DmMmi$temmt% . 

M^-^amesi 4&> ±$&©<t a ccpu 1 o (ta 5 ) a>£Ax i 5 

(15) 2 5 (25^ 2 5 2 S 2 5 3 

) %mmir%fz®(Dn 1 ©e»«*^ t^itsvLE d mimtztz 

* bzm^mmm® 1 4a, cme> 4 0 > >t*r- 3 9 , a* 3 

BS»*/iJ7^*7 M>FP-7 3 6 Mtf teftjfcf 3^:7 2 7 ( 2 7 t 
~2 7J(05) %M&frLXMbkt %7 Z 3- 3.^-$ 2 5 ( 2 5 2 5 2 , 
2 5 3 ) ( 19 5 ) * , ^K-A24 (1215) XttLEDCiffltS. 

7^f^P*>23s Xt-*24, ^7^^x-^ 2 5 ( 2 5 n 2 5 2 , 
2 5 3 ) ft JfO^f/WXJls C P U 1 0 £©|BK::&^T\ C P U 1 0 # 

vmw i ©ff »**nw-*- s tz®iz.<&mft&mm%mm%fi^®% «t a 

Cft $ frlT ^ § o 
( 1 - 2 ) MM 7 D ^ 7 A ffl V 7 h^x7W 
»[;;fflD#>> MIlKlbM^ l)5ijfP 7 D 7' 7 A 0 V 7 Ki7ilto 

III 7«s 1 tfein±lffllffl70^7A«)V7 h £xT8tf£ 

ft S<f % © T« & £ o ZQ>®7 Ki&WCs 5* X - F7-f/t. V^ft50lt 
£©$]#!! 7D ^7 A©ftTttJS tffig bs ft8t©7*;W X • F 7 4 H & <b ft 5 

F^^^ii, CCDW720 (1115) ^>*-f v^©i®m©=» vtfi-^-effl 



WO 02/065825 



PCT/IB02/00544 



11 

(2 5,-2 5 n ) igon-W xTtZTP-teZlTZrztbO'i — ? x — Z 
IffttSV? Fi)x7itft§^-ft;i/' D#>)> h 5 3 L «#©-0Jj&;?. 

>l»'D*?b5ei:*>6 M £ tit v^ a c 

tr* . 5 9*&a^$n-c^So £©«-k#7$>x# b • v*— y 

* 5 8 5±, D 4?^ 4 y 7 • wt • # "TP x. P h 5 2 N ?F^-$i7-l/'f 
^ g * - y 2 8 (15) t isjw $ n fc ^ ^. ^ g > 7 y -f ^ KBJft * tit v> * 

#*7*y h [g©^«6t»^^a^v^t &^7^ x * hogssfita v 

5 H ;i/ • £ x T - V -i -V 6 0 li N D^tM 2> £ • tfwt • t7^x ^ h 5 2 

Iltl V7 h >>x7ifA»f)iJ5S$ht^5, |fc77H"^>3> • 
W 6 1 fcfcs 5 • ^7x7- t 6 0 ©Iffiltttg bs ^1^ U* iV • 
^7'Ht4 0 4iJSt5#V7 h t? x7ft JvoTMSftfeMSSSI 

t|o"^tn| y Fill (DftWl*&Mt Ztztb® V7 h ^x7S*^il« 

5 KjV-^x7-b^t60SU i '77iJ'7--i/3>-P^t6 1 © Mf* & V 
7 }> tj7 xy^^S^tl^'tllll 8Stf09C^t. 5 h , iV-')x7' U-f 6 0 

/±ijfs ^pwniiffls mnm&m. 

-^^^x-;i/7 9 & £&£*SffiiB» 7 0 0 fc N £B 7J -fe V > :r -f ^73 >A 
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*t*frffl> KflttAK L E DMMSlftSSffl^^Mii^ J?a-;V 8 1 ~ 
8 7 8 0 0 fcfr £>8§Jjfc£*lT^3o 

£©i§£-EI$fS 7 0 OO^IMl^^aHH 0-7 8 a, B#fO 
^ . ~ A > -ft ~7 *J s. >? Y 5 2 © n — )V • D >it y b 5 3CtDDRAMl 
1(05) ^^^^ffi^nS^^V^x-^^jllftx-^S^^^^'-^©^ 

-;i/7 0~7 8 £^;L 5>ft3MfSJfltSo*^Tx l"o % $ V^ j s r# V> j N r PJ§ 

^ ^ j. r#-;i/£$?tti bfcjx r^ji^^ffi bfcj. rnu&nfejs rnpfrftfcjx 

&£©gs;&i>*^B©#x^x J.-ifA»5>©J8^»tf* KM 
^577'J^r->>3> • 1/4*6 1 ( Hi 7 ) Kffi*t5. 

T 7 » ,j /r — g > • -y 6 l«s 12 9 t ^ 1" J; 5 K x ffKl^x;!/^^^^ 
U 9 Ox fr 3?a-;i/ 9 1, #H^a-;v9 2, litres 3& 

tf^f^x^ 9 405o0t-7a-j^> 5>lifiSt£ ftT ^ S 0 

^ L T ^ tl ^ ff il ^ x ;V 9 0 j~ 9 0 n «x ^h?tlA*tV>rO^ 
>,t-#^a.->V7 6 /6^flli^^^#^^nfexi^^x^^©ElilSm^ 

4 k: $ ft r ^ s *rj& i- 1) ft # CD /1 7 * - * ii ft #ps l ft # & m < ff m & 
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gt^SHts 08l^tJ:^aio0;»F (#«) NODEo~NO 

0 D E o ~ N 0 D E n £$^3" * T- * A R C t ~ A R C n + 1 C» b X * tl 
tifcS^flt^P i~P a + tfca^t a*** - b 
^ h > t n? « ti s t ;v 3 y x a & ffl ^ § . 

Hftftj ^frift^r^ 9 0 i~ 9 0 n Hu ^n^ngBfflfrSft^T*^ 9 0 , 
~ 9 0 n £ 1" £ # ^ - F N O D E 0 ~ N 0 D E n K * ft * ftftJfc £ * "t n ^ 
ti&7-FN0DE„~N0DE n Ch©Sl 1 t^t i^itil^S 1 0 
0 LT^&o 

C©>Rfl8a^^l 0 0 T?«s ^©;-FNODE„~NODE n H^UtI 

r#-;i/&&fcH (BALL)j fc^5&iBJSg£j& $ #*.S>ftfc®'&^ 
fgjgfc&K#*£*l-S*®#-;i'<D r^§§ (SI ZE)j # r o * & 1 00 
0j©$6HTffc*£i:^ rpf|gfj£^ffi (OBSTACLE)j £l^Ktt£ 

m (DI STANCE )j & roA^l OOj ©SSH*Cfc S £ h^ftil©^ - H 

^fcC©7- FNODE 1 0 0 ^te.mMm^OXjlfttz^M&^&^Xb, 

nm^ytjv 9 o i~ 9 o ztfmwtifc&mt siit^ x> 9 3 swi ; ef;i' 
9 4 fc*ti*n#f**nfe#«i»»v*«*©^9pi-^ii ©a -fes^tt^x 

;V 9 3 \ZU&Zntz r|lf (JOY)jJI^ (SURPRlSE)jtKft 
rm Vfo (SUDNESS)j©^Tn^©^5^-^iii^ r 50^e 5 1 OOj 

©ISH-e&s i: giclifl©; - Pfca^* * c 8 * * 5 cfc^ tv^ § 0 

£$fe y - F j © 81 © ^ ~ K N 0 D E o ~ N 0 D E n fr h M&X * § J - h* 
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^^m^^ti^nm^^n, ?®;-fnode 0 ~nod e n £ji^-r sei 

teffl^l-^SfTMuP r ti&©^ - l»^©ji^**J © • fc * W" * r ttj^jfrSS j © 
frfcBaSftTV^. ft&\ rfiiioy- t^©;iM*j ©flHt*»S#ff© 
51$ ©IP iis 10 0 C%D ilftoT^&o 

El 1 1 ©>KMM 1 0 OtS^a^-Fnode 1 OOtBsi 
*{£ r#-;i/&jftai (ball)j u ^©#-;v© rs I ZE # 
r o £ 1 0 0 Oj © 16 H S S i: ^ a S * ^ # ^. & tb fe t J± s r 3 
0 ©51* "C r nodel20 (node 1 2 0 )j taglf^ ^ © £ 

TACT I ONI j <DftW)i)mjJ £ h% Z t % o 

Z VX&n »ir;v 9 0 j~ 9 0 n ttx *ft*ft£©J;5 fcJRSgS^ 1 0 
0 U T K» 3^fc - 1* N 0 D E 0 ~ N 0 D E tt < o * S * 5 fc b 
nt 43 D sX*t?Vr-( 3 Wt — # ^ ^a.— )]/ 7 6^& EH§§ 
6>ftfcl:Sfcir£x ftJiSf 3^- F N 0 D E 0 ~N 0 D E ft ©ttM 
Ml 0 Esfllffl Ltfl|J*s»K:^©fTi&*^^ bs ^^M^^fTttJ^^x^ 5?^ 

fimwWkTL^v 9 wts^m^f)^^^ u 9 0 ©#*?«)* ^ 9 
0i~9 o B *&*ft*ftffl:*j£ft?>fTi&©5'^ & ftfcftftjBtt© 

IK v» fr i& ^ 5 s ■N' 9 o i ~ 9 0 n & ffi # £ ti fc *t i& £ ?Ifft b s M^fJItt t ^fr 
t^^|©nv>f (J^Tn £ fi £ ff itt' 3 v > K £: n? £ ) t5F)V' 1 )i7' 
U-f ^6 0©l«A-lr?>TO^3>;t-^ 8 8 fc $ fcB I" £ o ft £ £ © « © 
J^tt £ £ ^ X \&s HI 0 t £ V^ r Til it IB £ ft fe fr S& ^ 5= ;v 9 0 t ~ 9 0 n 

f|^i;a-JV9 2 N Sl^ff 9 3»Wltril' 9 4 Cfcjflt*. 

5,tii>Ell^^© 5 ft, rnp^ftfcj rmr-^ftfej ft£\ i-^*e>©# 
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^ta -5 fri&^^^^w 7"^ u 9 o £*fji&-f 3fT»i ; ex;i> 9 o , 

~9 0 n ©#jB:r*»****S**. 

fl^M^^ 9 3 f± N r:gtf(joy)j x r$ b&(sadness)jsr!g £ (anger) J s 
'ft § ( surprise )js r M (disgust)j rjSfrl (fear)j ®M6o©fg 

K) fc O V^ T > fllttl £ i: K * © t* Sd © 3Bt $ & S t 7 * - 9 % b X 3 o * 

Ltsitr;p 9 3 ;i ft &#t»i!©^ *ft*ftx#-fev> 

ftfcj fc Jfffl#^©|gfi^^ fcs MHlP^lMTMlix^^-^ 9 1 * & 
© iiftl t ft if £ 3£^5 v> T jH JW fa t H St b T v^ 3 0 

7 9 £> # & ft 3 IBii *£3t £ n -tfflfc&OPtfy h i£ 8 1 © fr ®J rtuHlH 
fftr^a©^7i^F^^ft^^*^^"t^^©il^^^<fc^^yi$ft§^® 

t§©^©'fiS!i©^iiM^AE[t],?ia©^©f*iiffl^^^-^iiSE[t]^ 

*©«ltt©«JK**-r*»Sk 9 i:btx TI3©^ (l) ctotfto^lt 

fctt s*©it!&© ;t7*-*«E [t + i] u zft%m&(DZ(Dfiim 
©^^^-^^e [t] fcgggi^s«k5tb , r j t©tfaij©^^^-^<s*H 

it§. i|tr)bniis dftkli®£bt:£'T:©titl&©^7*-* 

E[t+l] = E[t] + kexAE[t] 

(1) 

a^Mic^^^-^ic^iiAE [t] C 
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fcH -te ^ > x i?73>;t-^^i-iV8 8 £> CD jlfcl i: l± x V> 
iD®&ft m<D 7 j - hVl >y jrfflfll (ff fJ^TIf IS) tfet), fx MQ&n&m® 

9 2 lis ^GDSi&fciS^TfTKl^T^ 9 0 !~ 9 0 a 3 « 

*H J E5 J ;i'9 4tt, rjggjj^ (exercise)j, rgffgfc ( affection) _N l"£ 
& (appetite)j S V r $?^'h (curiosity)j ©l^C»ulfc4-o©tlK'3 

^t, z.ne.ax*crjifc j e©fifc*©3Si$'*s , r^7^-^ ^ 5 „ * 

8*»e.©s«j5&iTK:s^v>tm^©«i^sc«fcD»ai$tLS*©ts© j e© 
flctll^Ai [k]s lfto^©t*®;i7^-^iSi [k], * ©$ 

*<DM4*"r**ki tt> R)T^jllllJi?THB©^ (2) feffl^TfcOli* 
££»**©&*© >"7.*-*« I Ck+ 1] JIfflbs C©M»i|g^^JlS 
©^0®:$©/^ ^ -^H I [kj i:I§i^^i^bt^0i*©^7^ 

< =& & * © ;t 7 ^ - * m & if if -r § 0 
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l[k+l] = l[k]+kixAl[k] 
(2) 

^^^'A^lllC^^^^tCfltAI [k] C if©gg©M&#X. S 
8fr&©SaftH±x r $!ftj OA7^-^i©^llAI [k] \z±%t£§m* 

# x. -s ± a t * -3 1 v> § „ 

ik 6 , k 1 ©fe%#titsii;RtJ c 8K#£fct-ffl#JCi8£2ft , t^3o 

8 8 it, 09Cwtiats ±$© J; 5 i;bt77'J^-^3>-Ht 
6 l off iftiSD&* c e^A-;v 9 l 6 ft* r^Bj^ r$^j N rp|< j x 

» r^7^>^ (jtf-^fcSiv^tt^j t ^ •=> feW^^fttrlft^ v > 
tB*^ 8 0 0 ©ftfe-r^li-ifM^ ^1-/1/ 7 8 - 8 4 C#i«. 

ft Mi-MS^ a — ;i/ 8 1 ~ 8 5 ff Hfrn v > F A s -¥ X. & ft* 

* 2 5^2 5 n (g| 5 ) S-*&U--#i!^fli*N ^ 2 4 (05) 
*6ffl*t4t<0fJ ! 'T-*SVXIi''SjfflI.EDC#A41l5 , -*44 

^.D#yffi 3S^fi^^fflH]!^ 14 (0 5) &Ji&^bT;ftjS-f ^ 
£ ff a C ii A* t? § * <fc a £ ft £ ft t ^ * o 

* cti bm^M^v a— /w 8 1 ~ 8 7 a. fr »3 v > h ft* 

^25 1 ~25 n (H5) *.<6^ n Xbf-A 2 4 (05) 
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)]/ • pjtfy h 3 3%.vm^WkMM& 14 (112) zm&ifrLxMBtzy * 

^3.^-2 2 5j~2 5 n X(iXlf-*2 4XBLED K Ji#3£ tH t S . 

(2) *5ll|(Z)»lifc*W , 5» 1 ©^*lftlB** 

d # y h i gg l 3 fc^TJ: 6 £s ftfcft* 

^ it & n & b £ s S 6 MjgR 8 ffi t) £ ti 3 «J#§P 9 © f&jffl 

PUlOfJS.Sfe, IMt^ 9 tt, ±ifc bfcWITC^- * h 3 A , 3 B , 3 C , 
£fi7*— # t J; ^T^V^il^M^tlfcP WM (pulse width modulation) 

mji^js i o it fftusfl-ff swifts 9 izmtj-r&o wAit D^Hiii 
h^g i ifimn^m^nmo^mt^^x, vtsyvmunz, 
% 0 mm^& i o &i\ c © £ -5 tffliss^nrv^iifRcff tttUfflT 5 -* ©a *> v 

3f^©^ff £S^"ttt£:o©fT ftft-jKx-* U b fc fr Wi fUB 5* 

~# KlS^^TM©-^^ bT^So ±$©FJT^©^ff 1 h«^ D 
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ft emails 7 ttx ±» tfc a ^ ffiu^^m 6 &ems 8 jc in* * n« mu 
#p it -9 * * - * - l x > m ft 9 \z ft * # jp t h n & ph © * p « 3 k: a ^ v \ x 

aiWSftfflt^o Wilis #J$# ■3#PWM>t;i/* , **<&»*fcttN ft* 
«t o X$t4kt 5 P WM;i;Ufl)M;^(ll:S^^t ft# * « 

{is ft*fflft$g^bTs ^ © £ fa ^ * £ * %n % o 

#©$««?" 3 2: ^ts?©ia ft»©«P^iM^©M^$ffit sftBffl 
g l ttxft*fc * Sftfec fcfcttb-t^ftfciJibTg^fciWffli 

* its 0j*«s b^a i t±s ft#©titiitm£©iM^& u 

-&T^< ati ^ ft**sft^$tiSiiiK:«tDN ^ ©ft* ©'»«$» ttl b 
*©ft*fc»j*t5WS©«i# («i«s r^jffit)j m) £iBga£«;i 

( 2 - 1 ) ft*0^ffl©H{*$l 

&.tes ft*©lfciH0fc»©^#^K:o^rfiW"r*. ±$©sl#i©M©i£ 

89 b t &T© J: a ft* x v 7te & t> s P wm;i;v* fc*-3 t rtoffimitn x 
HU^r^ffts h;v^A (Hal) fcPWM/wi/;*fc©Bl&&#i&£o 

i2oxf^m ^yvmxmmhtz-ti mm) tv^tB (h-jmi) 
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tb %> o 

(2 - 1 - 1 ) JJJKD hjvi' fcPWM^^ J:0M#ft*»4 (I l 

» 7") 

jtf, Ell 4-01 7tlt ^WKoV^ Mb* tPWMAWM il©^ 

mL, m 1 5 ©*gl|lfct;£f&lHIK^T^ U D9 1 6 ©*§*»£&]»£ oi^ T ^ 
b, 121 1 70^It«iIt-3^t^bt^5o ^ELT, #JHIK:o^ts 
&£Sfe£*»B-T©&WfilS (i?3^ > h 1 ~S>3*f > h 3) tfctt* kP 
WMrWVXtM t ©HM^ btl> § o * fcs Mili^Uli* !? C £ D W * §1 ^ 

^©ia i4~i 7 0«gl^tJ;M^ ir©i«ito^r«&s*t»^ttBSN«l 
&H**»tv^„ fliUf s f©ISm^*3v^*, PWM;i;i/*#ajTV^£ 

V^fo^S^M ##SLTl^o ««\ ^M&s ± 3 2 0©«Hl*n?»£ 

£i:ttT?£&VN, £©£?&<! tfr^x ^l^-ISs -h © -fe > > ^ £ « s *JfflT? 
§ Sfg^l^ffiffl U ^© J; 5 &*Jffit g5«iot* 6 HJttfiftK J: D 

#!l;U£slll 1 4~ 1 7 ©^ fix ©Blip <o bt>fr% X a txfiJfflT!* 
PWM;-ii^i s + 3 2 0 ~ + 5 1 2^-3 2 0 ~ - 5 1 2^feD>PWM^jV 
# + 3 2 0 ~ + 5 2 0 ®W>&® h %MMMMte'o^x\iZlk : £ 

( 3 ) ©i5tft5. 
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y=2 6Xx-7245 
(3) 

;i/*#-320~-5 1 2 ©itl^0 HV* 3 ®'J§lfiiH-o^T&*^ 

( 4 ) ©J;ac&5. 

y=28xx+805 1 
(4) 

(2-1-2 ) Hs >it^^tt«J bfe* (tUMO ©H&&:£&3 (8 

( 2 - 1 - 2 - 1 ) A&ttaitSJ'^rA 

HI 1 8Clis Fill * & If Sit" S *s Z J- A (KT, fi 

01si»7>72 0 2, A/D«gP2 03, 4 > # - 7 x 2 0 4 » 
rrffP^fgB 2 0 5 £«k ^T#!fiB£ftT^3o . 

coUffi^fSfflt S 3|*t>D-|^*i:ti:l»©A^>^20 1 a£3 
^[rO tlBB UT, #^jH2 >U- 2 0 1 a #&Jg& 2 0 1b OiltSi^tlfei 
ii:&o^^ 0 -teV-tf-2 o 1 tts z <D X. *> temj&te & <0s &JS&2 Olbi; 

^jf So 2 0 1 aliW-^t* b s "fe>t2 0 ltts 

«t ^ fcs^-^fc.fca :r y >y mist tit: v^o 

^0-fe>1^ 2 0 1 \Z&iX%im-i$htzm^\Z»gW}7>7 2 0 2 H tl, 

m®7>72 0 2 tt, iflS^tlTs A/D&&8P 2 0 3 tm*$ft§ 0 A/ 
D'MSP 2 0 314s «*.«s 8 try F0x-*^*^il IsXffij&Z ftX^ % o 
£©A/D^»g|5 2 0 3 tiotjEtU$ntftfer-^l^ ^fc«b*R S 2 3 
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0 5 K m # & ft a . 

\zm^xfiv>mtn%fio A-vj-frzi y if (pc) "c&^o 

m 1 9 ^^©S^bC^ ^ U 7*1^— >3 >)©fc#)©!®ffiEIMbTV>&o 

gift CfcSiii: #«t&f 3 a^-C^. 
VSil-«bfcffl*Iffllt5ii^*ft4*FI±ttTfflS(5)"?^*.nS. 

V = V 0 + F x (V1-V0) / (W1-W0) 

F = (V-VO) x (W 1 -W 0 ) / ( V 1 - V 0 ) 

(5) 

( 2 - 1 - 2 - 2 ) mUOtifrlo Yfrt^ © 
ft X v^„ 

ft £ fi ^ n lffifjnj£M b T § o #!j x. fi % i>F*7x^^ 

Lfcii^ Mv^ 7 fctDHfctt* * 3 Iff? 81 J &ffl^T^^©ct ^ 
( 6 ) #Wt5, 
r = J T F 
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(6) 



( 7 ) (Dkotzfrnttmzo 

i t % 

5 

31 o 2 

/ Jt 

0 
0 

0\/0 10 ON/cose! 



n 



31 

0 cos— 
2 

0 sin — 
2 



0 



0 

-sin 



3t 

COS— 

2 

0 



0\ 
0 

0 

1 



sin 



-sin 


2 


0 


0 


/cos0 1 


- sin 0j 


0 


0\ 


cos^- 


jc\ 


0 


0 


sin6 1 
0 


cos 6,^ 
0 


0 
1 


0 
0 


0 




1 


0 


( 0 


0 


0 




0 




0 









n 
o 
o 
o 

i o 



0 o 
o-io 

1 o o 

0 0 1 
1 o 1 

-l l 



A 



-10 0 0 
0 0 10 
0 0 0 1 



sinG! 0 0\ 
sinBi cosS! 0 0 



0 
0 



0 
0 



1 
0 



cos 6, 0 0 



^cosB,. -sinB,^ 0 0\ 
sin Q 1 
0 
0 



0 
0 



1 
0 



0 0 

-10 0 

N 0 0 0 

I SH10! cos 0j 0 1^ ^ 

0 0 -1 L 

-COS0! sinS! 0 
^ 0 0 0 1 

(7) 

* fe^ 'J>^U'J>^2tffl Ifflffl ( 8 ) © J; a &ff 81 fc ft § 



Oy 

0 



/l 

0 cos 

0 £ 

/ cos8 2 
0 

-sin 6 2 
0 



-sin 0 2 
0 

- cos 0 2 
0 



o\ 

0 
0 

1 



/cos8 2 
sinG 2 
0 
0 



0 
0 

-\ 
1 



— sin 8 2 


0 


0\ 


ri 


0 


0 


0\ 


cos0 2 


0 


0 


0 


1 


0 


0 


0 


1 


0 


0 


0 


1 


0 


0 


0 


h 


1° 


0 


0 


h 



(8) 
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u 2 i: y yz 3 k©io^ifeB*s ( 9 ) ©£ ? fcfraic&*. 



/cos 8 3 -sin6 3 0 1 2 \ 
0 0-10 
sin6 3 cos 0 3 0 0 
,0 0 0 1, 
(9) 

U 3 Kx7x*# t ©p^fflM}*^ ( 1 o) ©£?*Ht 



3 T„ = 



/l 0 0 lg\ 

0 10 0 
0 0 10 

^0 0 0 1 / 

(10) 

5$ (1 1 ) © cfc -5 & It ?U A 5 f# ti § o 



°T E = °T 1 % 2 T 3 3 T B 

/ saCs + ca -SA^ + CA s& ^(saQ+c&Hsa+i^ 
sa -s 2 s 3 -c 2 lAC.+iA+i^+ii 

- 0,0,03 + CAS 3 + SA - C& 1 3 (- 0,0,03 + SjSj-laCA 

0 00 1 

(11) 

:nt«fcDs ^-*l£«©M£:s x>Fx7s^c0S0s WT© 
J;«S(12U(13KS(14) #?>"^ (15) 



p x =i 3 (sAC 3 + c 1 s 3 )+i 2 sA+i ftJ 
p y =i 3 SA 3 +i 2 s 2 + io y +ii 
p.-i^-cw^+s&Hca 

(12) 
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^-=1 3 (C 1 C 2 C3+S 1 S 3 ) + 1 2 C 1 C 2 
— *- =1 3 (-S 1 S 2 C 3 )-1 2 S 1 S 2 

de 2 



dQ =i 3 (-s 1 c 2 s 3 +c 1 c 3 ) 



(13) 



dP v 
dP 

d0 2 323 22 

dP y 

d8 3 



(14) 

5--i,fec 1 c,+CA)+iACi 

^--l 3 (C 1 S 2 C3)+l2C 1 S 2 

^-^(caSs+sa) 



(15) 



/i 3 (c 1 c 2 c 3 +s 1 S3)+i 2 c 1 c 2 ^(-s^a)-!^ ^(-s.ca+ca)^ 



J = 



0 1 3 C 2 C 3 +1 2 C 2 -1 3 S 2 S 3 

^l 3 (SiC 2 C 3 + C 1 S3)+l 2 S 1 C 2 i 3 (c 1 s 2 c 3 )+i 2 c 1 s 2 ^(qc^+sa) J 

(16) 

W±cd J: a ic n * >y h mU® U > * ft * 5 s Mb * * c £ K: «fc D x -V 3 if ff M 

( 2 - 1 - 3 ) © b ;v * ^mfc a i> h ;i/ * © M <z> ft t 
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H$ij© b;v^», ±ai0X*JS@ ( i - l - l ) t^rMbfc h;v*t? 
* t>, *iti b;i^y;, ±$©£#ip?g ( 2 - l - 2 ) icfcv^tttW 

i ~m 2 6 ^ mmvYJvz £ s t) * > * ®m * & m 1 1 a & b » 

^J:®li4^77J:l-C*ltv^c 01*. lis ^57tl5^t, MS, X 

^tctDf#feh;V^ (^j-fe >-»?- (forceSensor) tfe^ 
JSWKx Mfflb;^ (ApproxEqu) "C % § , i; fc , 0 2 1, 2 2(t 
> b 1 33 § lift * Is 121 2 3 , 2 4 ft, yM>h2C^»5S<»4^ 
b , 02 5, 2 6 tt, ^a^>h 3t:fcij-§Si§Sbt^l>o ^ b T , 02 
1, 2 3 , 2 5 ttP WM/V^ C H bIE©M&^ b, 0 2 2 , 2 4, 

2 6 ^©AOMfc^bTV^o 

i?a^ > h 1 Ho^ttt^S (17) ©J;-5fci8&5£&f& 3 Chtf Tf SSo 

y = 1 . 2336X-866. 14 (0 2 lt^Jfe) 

y=l. 4963-231. 59 (0 2 2 K^J5&) 
(17) 

WT, Pltio * fc, a > b 2 to^ta*i£ ( 1 8 ) O X o ftiftS*^ 

y=0. 529X-7893. 45 (B2 
y = 0 . 4 9 3 4 x + 9 1 0. 11 (024C^) 
(18) 

^aOh3 toi^tiftS (1 9 ) ©J: a &§I#5££*§S C 

y=0. 6115x-51. 28 (0 2 5l:^J£) 
y=0. 8738X+1056. 7 (0 2 6 t*fJiS) 
(19) 

£Jt±©a;5 c> 0 2 l ~ 2 6 jcwt * 5&Pift#£>s * i: P WM;i;v^ J;© 
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^ - ® J; o ^ H # 5$ t j: o r # 5. ^ § ^ t Pfi ^ ^ ti § * ® ^? * v ^ 

127-130 fcfcU W±© J: a fcgl^ifc&fijffi bts ^iPX-fc il 

02 7 ~ 121 2 9 tt, £oTl^M©H#y f$|glC*fLT#;£f|Fefr$># 

* in it fc m & © is m & ^ b t & u s in 2 7 » x ff * a c * * hi x. tz m * t? & & * 
©jems^btv^o $ix.«\ a 2 7 om^^mt itftf s t> m^iri^a 

&#©J«#TS ^Jnit-Ciw fc i: ^ -Tfcfc^ MSB 1 © 

ftH-S!D t*Si0itUofet§ffllSSS*LTV^ o ££T!x Fx, Fy 

m±A\ ^*©$tffi©fc&©JI#^J £ b-C©^ ^MMt#£ti ?>*©'»« 

& s o 

§ J it H\ d y h Stt 1 fcfcx C © £ -5 C b T tft tU b & & b U * 2: b T x 

D^ta-rsKif^&iRbtfifctftsso 
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(3) #HIII©^«IK:*W*»2(Z)^*|fttf*tt 
(3 - 1 ) DinSIl ££l:J-Sft;tj&fcH£& 

n 3j? y Fill Iz^^X^s & fimiZ&tt%&M33--y h 3 A~ 3 D©M 

ftm*zti j etiMW}^ j $>wij]¥*Ri^xniii u »ttu3ii ; HH^tf bT^ pp 

gRi-y h 3 A~3 D ©Mil 15© bf y ;£ fa n — Inl <D £ 
»i?g|$S$«ft©:ftjfe-r&#r *^ax-* 2 5 SJKttfJPfSC hCiU 

\Z <fc D H*i = S5» b 3 A~ 3 D©jfHi5«a^KPia«^^il^^^^ t)x C 
^ctufflD^-y Mil x-lt, W bTft&Mftffligtf^- y h 3 

2 5 (&Tn ^ti^MHa5b°y^^lqIjlT^^i^-^2 5 fcn?£) 

#i«i©^©i; £©« (£^T^ .r ti^HMin^-SO iioi^^ifflbx £tt 
§§bfc fc^Uft * J: 5 c bt\ hom^^t %> «fc 5 KfcSftt^*. 

ft£^Tfc:feVNT&sifi^©P$3.-y b 3 A~ 3 DCo^t©**S^$ 
jg 1 ©MtotfttH^fi&ktftfs ^ffilCJWgP^.- f b 3 A~ 3 D £oV>T©frfr 
§ £ £ 2 © IM«{±5£& t D?^ % © fc t %> o 

££T?03 1 &^§t>#&V^g©Pg|5:x- y b 3 A~ 3 D©BWStft: y 

^^I^MT^^a^-^25^#^.feJ|^tfi:^l^i[i:©H^^^-r^77 
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3 1 Xits jfijj*** St LX^ 3 <fc a fc{iJiS.&V^ 3 ftfcfcjg** 

t%fc&x& Ds-*©^77S«i*iqiK:^7 h-mM^^HM© 2 

-5, 0 3 2 A~32Cit D^nill «fT£*tM«9£®&£* 
fe^g©iPMS-fe>itl9 (El5)0m*K4 (I32A) M^©#PSP 

Mtf^iiltonflt (03 2Bs 3 2C) a ^ 7-C&3 , 

£ ©Jillria 3 2BK*V>txTISOKBttD*S' Mil C £ 3 tu iBi © 1W 
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If ForceKind == ForceToFoot 
if BehaviourStatus == Walking 

Command(StopWalking) ; 
if BehaviourStatus == Standing 

Command(HandsUp); 

If ForceKind == ForceToBody 
if BehaviourStatus = Standing 
if ForceDirection = Backward 

Command(SitDown); 
if ForceDirection = Forward 
Command(LieDown); 
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FIG. 11 
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